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toofifitivi 4ul-ira robot*. Is the poai t ioa-poti t loa eoatrol 
adapt It* controllers ensure that the end-effector positions of both irai 
daalrad trajectories ia Cartesian apaoa despite unknown tta«-fi 
interaction forces atartad through the load. Ia the position-hybrid ot 
strstsgy, tba adapt It* eoatrollar of oao iri ooatrola end-effector motic 
tba fra# directions aad applied force* ia th# eoaatralat diractioaa; vhil 
adaptiT# eoatrollar of tba other ara aaaarai that tba aad-affactor t 
daalrad poaitioa tra jaator laa. Ia tba hybr Id-hybr id eoatrol stratag] 
adaptiva eoatrollara aaaara that both amd-affactora track rafaraaea pot 
trajaetoriaa while aiaml taaeously applying daalrad foreai oa tba load* ] 
tbraa control atrataglee. tba eros a-eoapl lag affacta bctvaaa tba ara 
traatad tc ^disturbances* which ara rajactad by tba adaptive ooatrollara 
following daalrad eoaiaadi in a eoaaon fraaa of rafaranoa. Tba ada 
eontrollart do sot require the ^bapTez^aatheaat leal aodal ot tba ara dye 
or any knowledge of tba ara dyaaalo paraaatara or tba load paraaatara ai 
aan aad stiffness. Tba eoatrollara hew# s lapis atrnotiraa mi 
coapatat tonally fait for on-line iaplaaantatioa with high stapling rates 

1 • Iatrodoct ion 

Daring the pest daeade. robot aaaipnlators bnva baan ntilisad in industry for parforaing staple tasks, aad 
it la foraaaan that in tba naar future anthropomorphic robot a will raplaoa huaan operators in oarryiag ont 
warioui eoaplaz tasks both In industry aad ia hazardous snTlroaaeats. Nevertheless, present-day robots earn be 
considered at best as "band icapped” operators due to tbair aingle-ara structure. It la evident that 
multiplicity of robot eras yields greater dexterity and ineraaaad efficiency and provides tba oapability of 
handling larger loads. Dual-ar* robots will therefore have capabilities which aay natch those of aabideztrou* 
baaan operators la deztsrlty aad efficiency. 

Tba research on dual-ara robots la at its early stages at the present tlaa, and a faw approaches ara 
csrrantly available. Nakano at el. [I] propose a method for control of dual-ara robots in a aastar/alava 
manner. lahida [2] considers parallel aad rotational transfer of loads naing dual-ara robots. Fuji! tad Cnroao 
[3] suggest a technique for dnal-ara control based on the method of virtual rafaranoa. Alford aad Belyen (4) 
describe a aatbod for coordinated ooatrol of two eras. Zhang and Lab (5,61 obtain oonatrained relations and 
control laws for two coordinated ara*. Tarn at al. f7] employ tba exact linearization technique for dual-ara 
control. Bayati [Si proposaa a method for controlling dual-ara robots based oa partitioning tha load betwaaa 
tba aras, Koivo [9] suggests an adaptive control technique for dual-sra robots using the self-tuning approach. 
Lia and Chyung [10] describe a positional control scheme for two cooperating robot eras. 

The control architecture considered in this paper is baaed oa the tri-level hierarchical ooatrol of dual- 
ara robots as shown in Figure 1. In this tri-level control architecture, the high level plans the task to be 
performed and decomposes the task into appropriate snbtaaks for the right and left eras. In the intermediate 
level, each anbtask is tranaforaed into a sequence of aynebronoua desired trajectories of end-ef factors motions 
and applied forces. The low level is concerned with the ezecutioa of the desired trajectories aad employs 
feedback from the current status of the aras. In this tri-level hierarchy, the low level "achieves” the 
desired aotlon and operates In "millisecond” tine-scale, the intermediate level "determines" the notion desired 
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for III iiluik it i»4 tha kick lml "pitas" tha uktiik immbcii is v il»iti a Um-miU 

Tko frmit 9 *ft <mrlWi Uni aoatrol slfit«|lci toe lovlml ilifllvi aoatrol ot iMfmtlv* dmal-aro 
robots aalag n««ak rmlti oa HipIlM aoatrol of ila|l«-«ra robot! (21-19). Ia took ooatrol analogy, a 
sal table task-related eeerdlaate frtao of refereaeo it ehooea for both am aad tba desired •otloae iai applied 
foraaa for oaah tra ara expressed la thla aoaaoa rafaroaoo fraao. Thoa oaab ara olll am aa tkoagh It van 
oarrylag oat tho ooaaaa4t4 aotioa by ttaoif ia tho rafaroaoo fraaa. Tfco adaptive aootrollora aaaara that tba 
aoatrolla4 variables traoh tho 4oaira4 rafaroaoo aoaaaa4a aa4 rajaat tho aawaata4 4ftat«rbaaaaa aaaao4 by 
lataraatloa foraaa aa4 torqaes aaarto4 throagh tho lead. 

Tho paper fta atraotaro4 aa follows. Ia faatftoa 2, tho pesitloa-positiea aoatrol atratogy la dlseassed. la 
Sootloa I, tho positioa- hybrid aoatrol strstsgy la developed, Tho hybrl4-hybrl4 aoatrol atratogy ia a44roaoo4 la 
Sootloa 4. Sootloa 5 41aamaaoa tba raaalta of tba paper sad 4rava aoaa eeaelasioas. 


2. MlUtiAlillaAsUtl lumn 

la thla aaatloa. va aboil lavestigste tba flrat aoatrol atratogy for 4aal-ara aaaipalators ia vhlah both 
araa art la para poaitloa aoatrol, aa shova ia Figaro 2. Ia otbar vor4a, tba poaltloaa aa4 oriaatatioaa of both 
aa4-affaatora ara reqalred to traak 4aalra4 trajaatarioa la a aoaaoa fraaa of rafaraaoa. Ia tbia aitaatioa. 
aaooatrolla4 foraaa aa4 torqaes vlll ba aiarta4 oa tba aoaaoa loa4 baU by tba aa4-affaatoro. la tbia see ties, 
va lavestigste tba porforaaaaa of tba poaitloa aoatrol ayotoaa ia tba faaa of tbo lataraatloa foraaa aa4 torqeis 
aaorta4 throagh tba load. 

2.1 failtloa ftiiiailfi tax llihl/1 ill Ata 

Tbo 4yaaa ia ao4al of aaah oaalpalator ara aaa ba raproaaata4 bp a 41ffaraatlal sqaatioa ia Cartaaiaa apaao 
aa (14) 

M(X)X o N(X,X) ♦ 0(X) ♦ B(i) ♦ f - F (1) 


vhoi 


if la 


X.X.X - asl vectors of ead-effeetor poaitloa, velocity aa4 

acoalaratioa la a flsa4 taak-ralatad Cartaaiaa fraaa of 
rafaraaoa 

F “ axl vector of "virtsal" Cartaaiaa foraaa appliad to tba aad- 

affaotor aa tba ooatrol iapot 

M(X) - aaa ayaaatrio positlvs-dif iaita Cartaaiaa sail aatria 

N(X.X) « ul Cartaaiaa Coriolis aa4 oaatrifagal foraa vaotor 

C(X) • axl Cartaaiaa gravity loadiag viator 

B(X) - axl Cartaaiaa frlotioa foroa victor 

f • axl victor of forcaa a ad torqaaa axortad by tba sad-effietor 

oa tba load 

Tba force/ torqm victor f both iaparta aotioa to aad appliaa forca/torqma oa tha load aad acts as tha coapliag 
alaaaat batvaaa tha two araa. Ia tha folloviag aaalyaia. tha foraa/torqaa victor f vlll ba coasidarad aa a 


”dlstar baaea iapot" to tha poaitloa coatrol systsa. Tha faactioa of tha ooatrol syataa is to sasara that tha 
amd-sffactor poaitloa victor X tracks tba axl victor of daslrsd trajactory X d daspita tha distorbaaca foroa f. 
For sach ■aaipalator ara, lit aa apply tha liaaar adaptive poaitloa coatrol lav [12] 

F(t) - d(t) ♦ (Kpd) K ( t ) ♦ L r (t)B(t)J ♦ (C(t) X d (t) ♦ B(t ) i d (t) ♦ A(t) Z d C t ) 1 (2) 

aa shova la Figaro 3, vhars B(t) - X d (t) - X(t) la tha axl poaitloa trackiag-arror vaotor. Ia tha coatrol lav 
(2). tha axl victor d(t) is aa aaxlliary sigaal to ba ayathasixad by tha adaptatioa aehaaa. vhlla H p B ♦ I V B) 
aad (CX d ♦ BX d ♦ AX d ) ara tba ooatr ibat loss daa to tha faadback aad faadforvard ooatrollars raapao t i valy. 
Folloviag tba aathod daaoribad ia lafaraaca (12), tba raqairad aaxlliary sigaal aad ooatrollar galas ara apdatsd 
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i 


1 


t 

*(*> - 4(0) ♦ », / r(t)4t ♦ » 2 »<t> 
t 

* f <t> > 1,(0) ♦ aj / r(t) B* (t)4t ♦ # 31 ( 1 ) *'(») 
t 

*,(») • 1 ,( 0 ) » % x l r(t) B’(t)4t ♦ Oj»(l) B'(t) 
t 

C(t> - C(0) ♦ / r(t) XJ(t) 4 » ♦ r 2 *(t) XJ(») 

B(t) ■ >(0> ♦ n /*»(») *i<*> 4 * ♦ Tjr(t) X 4 U) 

*(») - 4(0) ♦ Xj / t(t) Xi(») 4 ‘ ♦ Xjr(t) 14 (f) 

vitro 


( 3 ) 

<41 

(3) 

<*> 

< 7 ) 

(I) 


r<t) - f f E(t) ♦ I(t) <9) 

it aa nil victor, (6 l# yj, t|* kj) are positive sealers, lij, ^2 # * 2 * Tj* 9 0#ltlT# or 

sealers, tod tic priae domotot t r tot poai Horn. U c^utiot (9). f p tad l t art ui constant v«i|Ml«s aetrieea 
ehosea b y the doaiftor to raflaot tk« rclittvi significance of tho po.itioa tad velocity orrora B and 1 It 
■mat bo aotod that tiaoo wo oaaaot physically apply tho Cartotiaa ooatrol foroo F to tko tad- of factor, wo 
laotoad ooapaco tbo aal eqoiveleat joiat torqae vector T to effectively oaato tbit foroo. Thao, for fttgh 
■aaipalator ora* tbo ooatrol law la joiat tpaoo it given bp 


T(t) - J ’<»> F(t> - J’(»> ( 4(t) ♦ Kp(t)B(t) ♦ C,(t)B(t) ♦ C(t)X d (t) ♦ B(t)i 4 (t) ♦ A(t)X 4 <t)l (10) 

where 9 it tho ail vector of Joiat aagwlar potitioaa aad J(9) la tbo aaa JaeobUa aatrix of tho aaaipalator ita. 


Booaato of tho siapiioity of tho adaptatloa lava (3) - (I). tho robot ooatrol algorithm eaa bo laploaioatod 
at tag high sampling ratoa (typically 1 Us). Ia each taapliag period (** latte), tko ooatrollor galat oaa ohaago 
• iga i f ioaat ly; whereat tho teraa M. N, 0, B, aad f la tho robot aodol (1) oaaaot ohaago aotlooably. Aa a 
ratal t. ia deriving equations (3) - (I), It vat attaaod that thoto teraa are aabaova aad "slowly tlae-vary lag" 
relative to tho adaptatloa law*. It it teea that tho laoiatioa of tko dlttarbaaco force f la the robot aodol 
(1) doea aot of foot tho coatrollor adaptatloa lift alaoo tho ohaago la f over oao taapliag period It relatively 
•■all. 


Tho above argaaoat aaggoata that vhea both aaaipalator araa are controlled voiag tho two JiJiuiilll 
adaptive poeitioa coatrollert, we expect tho osd-eff retort to track tho dealred potitioa trajectorlot doaplte 
tbo interact ion force* aad torques exerted throogh tho load. It aaet bo aotod that alaoo tho forco oa tho load 
ia aot a coatrolled variable la thia scheae, thia atratogy caa load to madoolrablo load force* whoa tko poeitioa 
trajectories are aot plaaaod ia eoordiaatioa or are aot tracked cloaoly. 


3. P9flU9B-glVf id CpBUftl 3 1 X1.1111 

Ia thia section, tho poai t ioa-hvbrid control strategy for dael-ara ■aaipalator* will bo atadlod ia which 
tho loft tra ia ia pare position control and the right ara la ia hybrid pot 1 1 ion/ for co control, aa shown ia 
Figaro 4. Ia other words, for tho loft ara, tbo tad-effector position ia required to track o desired trajectory 
ia a front of reference. For the right ora, ia tko eaao reference frcao, tbo contact force between tho end- 
effector and tho load anat bo controlled ia tbo directions constrained by tbo load, while tko ead-effoetor 
poaitloa ia to b# controlled a iaal taneonaly ia the free directions. Thia ooatrol strategy can bo applied when 
one robot era la confined to operate only in position control aode whereat the other era con be controlled ia 
hybrid control aode. 
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carted llrM|l III Ui4 in «iui4i 
R 4iitiflm«i,* i»4 III ilifthi fiiHlii aoatrol ijitia m ititn truklai if Hi lulu! paaitiea 
triJiiiMin Infill ml IlituliMii, at ntliail U Intiit 2. Hi iliftivi fiiltlii mini lav for ill 
laft ara aim U Pifin I la |iti« by 111] 

T t (t) - *((•(> (4(t) ♦ I^d>t(t) ♦ I,d>iu> ♦ ?<t)X t4 (t) ♦ 7(01(4(1) * I<t)i t 4<»)) (11) 

tkifi T( t« til a«l J«lil l«i|M fHioi, #( t. tk* ail jolat aagl* /((•(> •• ,k * aaa Xt.okl.a aitili, 

1(4(1) la 111 ail finir of liainl Cartaalaa positlea trajsetary, B(t) * l(|(t) - X(t) la tha ail faaitiai 
trsekiag-errer vaetor aa4 tka terms la a^aatioa (11) ara adapted aa follova: 


„ t 

4(0 -4(0) ♦ *! / r(t)4t ♦ *j»(t) 

(12) 

fyt) - f_(0) ♦ «, / , r(t)S’(l)4t ♦ • 3 f(l)S'(t> 
w w 0 

(13) 

t,(») -1.(0) ♦ lx / * r(»)S'd)4t ♦ 4 2 <(t)S , (t) 

(14) 

7(t) -*<0> ♦ / ^d) I( 4 <t)dt ♦ »jr(t) Z( 4 <t) 

(IS) 

t 

1(1) -f<0) ♦ T( / f(C) X(4(t)4t ♦ Tjrd) X^d) 

(id) 

- - ‘ 

A(t> - A(0) ♦ / rd) X ld d>4» ♦ X 2 r(t) Xt 4 (t) 

(17) 

. 

r(t) - o^mo ♦ 9 r id) 

(11) 


tad Ik# symbols ara daflaed la Seotioa 2. 

3-2 Bxfexii Coaugllfi lax tiiM kin 

Va Skill aov diioaat tka hybrid posit &oa/ forea ooatrolltr for tka ri|kt ara. Coaslder a taak-ralatad 
"coastiaiat fria«" (coord i ante aystea) thick la daflaed by tka partioalar eoataet aitaatioa oecerriag betveeathe 
rlgkt ead-ef factor aad tha load. la tkia fraae. tka a degraea-of-fraedwa (or diraotioaa) ia tka Cartaalaa apaaa 
(X) oaa ba partitionad iato tvo ortkogoaal aata; cka a ooaatralat diraotioaa ia aabapaoa (X) aad tka 1 fraa 
diraotioaa la aabapaoa (T), vitk a • a ♦ l. Ia tka a ooaatralat diraotioaa. tka aad-af factor aakas ooataot with 
tka loMd aad tka saalAMl lata*. ittdi to m aoatroilad. Ia tka 1 fraa diraotioaa. tka aad-affaator ia fraa to 
aova aad tka ftliUlilllDX fflililO i* to ba ooatrollad. Ia tka hybrid control archltaotara (16.171. tvo 
aaparata controllers ara employed for aiavitaaaoaa forea aad posit ioa ooatrol. Tka "force eoatroller* aehtevas 
tracklag of daairad forea aatpoiata ia tka ooastraiat diraotioaa; vkila tka "poaitioa eoatroller” aoeoapliahes 
tra eking of daairad poaitioa trajaotoriaa ia tka fraa diraotioaa. 

Tka dynamic aod«l of tka rigkt ara ia tka ooastraiat diraotioaa eta ba vrlttaa aa (13) 

A(X.i) P(t) ♦ BfX.i) Pit) ♦ ?(t) ♦ C p (7) t f* * V° (i9) 

vkara P f ia tha ail "vlrtnal" Cartaalaa forea vaetor appl lad to tka aad-affaotor ia tka ooaatralat diraotioaa, Z 
ia tka axl vector of tad-effector poaitioa. tka ara aatrlcas A aad B ara kigkiy complex noallaaar faaotioas of 
tka aad-affaotor poaitioa X, C p ii tka oroaa-eoapl i eg from tka poaitioa loop ia tka force loop aad f g is tka 
poapoaant of tka forea aiartad oa tka aad-affaotor by tka load la tka ooaatralat diraotioaa. Tka tara f g 
raprasanta tka oroaa-eoapl lag tkat exists betvsaa tka arms tkroagk tka load aad ia eoasiderad as a *dia tarbasee” 
to tka kybrid coatroilar. 

In a raoaat papar [13], aa adaptive foroa ooatrol schema la davalopad vltkia tka kybrid ooatrol 
areki teotmro. For tka rigkt ara, tka llaaar adaptive force ooatrol lav la tka ooaatralat diraotioaa is givta by 
(13) 
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r,<«> - r # u> ♦ 4(t) ♦ ijtt) *<*» ♦ *i<«) t ■ «,<*>*<*> 


•• ikm ia Fi|ui 5, tlMtt F f (t) it tk« 4,tlr*4 tntiit fare* aa tka laa4 aaa4 aa a fa#4faraar4 tara. 4(t> tc 
„ (aail iary atfaal. I(t) - F,(t) - Kl> la tka 4aaUtlaa at tka aataal faaaa P(t> fraa tka 4aalca4 aalaa. aa4 


(4 f (t). K|(t)> 4,(0) 

a4afta4 aa fallava: 


•liar. Tka 


1 la* (M> 


4<t) - 4(0) ♦ * t / «<t)4t ♦ *j«<t) 
0 


C x (t) - 4j(0> ♦ a x / »(t) <t)4t ♦ ajO(t) «•'(!> 


4 f (t5 - 4,(0) ♦ / «(t) 4* (t)4t ♦ Sj«<0 ■*( 


4,(0 - 4,(0) - ri / <(t) Z’(t)4t - TJ0<»> X*(t) 


*(0 • *i 4*( t) ♦ 1,4(0 - *,2(0 


la aaaatiaaa (21>-(2J). BOO • / B(t)4t It 

0 


(4j. *|, ri> ara paaltiat taali 


U 2 , ,j, pj, TJ ) art potitl.t or aaro aaalara. aa4 (*j. *.. t v l ara aaaataat «ai|ktla| aatrloaa akaaaa by tka 
4atl|aar to refloat tka ralatloa aifaifloaaaa of 4*. B aa4 2. 

Tho dyaaalo aod.l of tko rl|ht ara la tka frao Blraatleaa oaa bo arlttaa aa (IS) 


* (X.i) 5(t) ♦ B # il.i) i(t) ♦ C 0 (I.i)T(t) ♦ C f (P> ♦ ty * V tl 


vhiri f it tk« coapoaent of tko •td*«f(«otor foreo ia t)i* fm direetioaa, Cy it the croet-eoapllng froa tko 
forot loop* A 0 , B 0 , C 0 trt oonplex aoallattr aitrloot, T it tko end-effector potitioa vector tad F y i* 
"olrtaol" oad-offootor ooatrol foreo. For tko ri»ht ora. tho llaaar adapttvo pooltloa ooatrol la* la tba frao 
diroctloat It givoa bp 

F y (t) - 3(t) ♦ t p (t) Kp(t ) ♦ f T (t) Bp( t ) ♦ 2(t) Kf) ♦ Kt) i(t) ♦ X(t) i(t) (27) 

tt ia Soctioa 2. where t it tho dotirod potitioa trajectory. Bp - I - T it tko potitioa tracking-error, tad V 
it tko "vlrtaal 1 Cortotiaa foreo la tko froo dirootloat. That, ia order to iapleaoat tko foroo tad poaitio 
ooatrol lert (20) tad (27) it tho hybrid ooatrol architecture, tko Joiat tptco ooatrol low for tko right ara it 
given by 


f ' \ 

r r u> - J'<» r ) 

\ Hy<*> / 


tt ahowa ia Figaro 6, where i f it tho joiat taglt vector, T f it tko joiat torgae vector, tad J r it the Jacobian 
aatrii of tko right era with appropriate reordering of eolnaat of J f if tocetttry. 

Tko hybrid controller adaptation loot (J)-(l) tad (21)-(24) are extreaely tiaplo, tad therefore tko control 
algorithm eta be iapleaoated atiag high aaapliag ratet (z 1 EBt); yielding in proved perforataco porticalarly la 
force control tppl let t ions. Since in etch ttapllng period i aeoc) tko terat in the robot aodela (19) tad 
(26) cannot change noticeably, it it rettoaable to ttaaae that theta terat are "alowly tine-varying* ooapared to 
tko adaptation tekoae. That tko laolaaloa of the dittnrbaace forcot f, tad tj ia tko robot aodela (19) and (2d) 
doet not affect tko controller perforataco. 

Vo conclndo that neiag tko poaitioa-hybr id control atrategy, the left oad-effector will traek the dotirod 
potitioa trajectory deapite the iateractioa forcot throagh the load. The right ead-effector will eaert tko 
detirtd force oa tko load ia certain dlreetiona while tianl taneontly tracking tko dotirod potitioa trajectory la 
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tk« ortho fatal 4inttiou. It n*t ba m(W tkat is tbit aoatrol atratafy. all|bt flaataatloaa u; ba okiinii 
•* (wm 4m ta *«r aaall vlbratioaa of tha laft a to m4u potitloa aaatrol. 


la tfcla aaatiaa. the hybril-hybril aaatrol atratagy for laal-ara aaalralatera *111 bo stalled U ahiak kotk 
araa art la kybril post tiea/foro* aaatrol. at akaaa la rigara 7. la atkar tadi, la a aaaaaa fraaa af 
rafaraaaa, fa* botk araa. tka faraaa aaartal by tka tal-af fsttors aa tka loel la tka aaaatralat liraetteaa (Z) 
■••t ba aaatrallal, aklla alaaltaaaeaaly tka aal-affaatora ara taftlral ta traak la a Irak yaaltlaa trajaotorlaa 
la tka fraa llraatioaa (T). lay aaaaatal faraaa aal torqaat aa tka laal (aaaratal by tka ralatlra yoaitiea aal 
MlaaUtlaa of tka aal-affaatara *111 art aa 'littarbaaass," aal tka alaytlra kybril aaatrallara aaaara tkat tka 
laalral posit iaa/ ferae trajaatarlaa ara traakal laaylta aaak llatarbaaaaa. . 


4.i Hun flmaiiu lu Kiiki/Ufi Au *■ 

Fella* lag laatlaa 1. far aaak aaalyalatar ara tha kybril yaaltlaa/faraa aaatrol lav la tka jalat spaa* aaa 
ba vrittaa aa 


/v«\ 

- JMd) I ) 
\F y u>/ 


•koto 1(1) It tko Jtooklaa stir la (wltk appropriate oolmaa reorder i*$ If Mtitury), aa4 F t (t) u4 F y 
•wlrtaai" Carter ita foroet tpplied to tko tad-offeetor la tko coaetralat direetioat (Z) tad frit diroi 
respectively. Am tkowa la Figaro 9, tko foroo ooatrol law it glvea ky 


<t) aro tko 
etloat (I). 


V«> • *r<*> ♦ ♦ *r<t) / «,(t)dt ♦ ^(01,(1) - (JO) 

ahora P r (t) la tka laalral fore* aatpoiat, 8,(1) - F r <t) - F,(t> It tka forca traekiaf-orror aal tka alaptat* 
lowt tro: 


d<t) * 4(0) ♦ 6 1 *(t)dt ♦ 


*t<t) * f ! (0) ♦ «! / q(t> Bj'(t)lt ♦ «j,(») gj'(t) 


*p<t> * Bp<0) ♦ >1 / q(t) Bt( t)lt ♦ l2«(t) Bj(t) 


V*> - t^O) - ti / q<t) Z’(t)dt - y 2 q<t> V (t) 


«(t) - W lB J(,) ♦ *pB c (t) - p^zct) 

# t 

^ *»(t)lt aal (fj. fp, l,| ar* laalral vaightiag aatrieaa. 

Tko potitloa coatrol low it otpretted «t 

r,(t) - i(t> ♦ Kp(t)Bp(t) ♦ E^oiyU) ♦ ?<t>B<t) ♦ I(t)i(t) ♦ I<t)i<t) on 

wkoro *(t) It tko dotirod potitloa trtjectory, H y <t) * *<t) - T(t) it tko potitloa treeklag-error tad tko 
odoptotloa lowt tro: 


d(t) • d(0) ♦ 5« / r (t)dt ♦ ? 2 r(t) 
1 0 * 
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_ t _ 

!,(*> - 1,(0) ♦ tit) B£(t)4t ♦ , 3 f(l)l}(t) 

t,(*> ‘ V®> ♦ M / # **(*> «y< *)4* ♦ 7 2 '<t)if(t> 

t(*> - 1(0) ♦ / *,(t) t' (t)4t ♦ Kf(t)«'(t) 

0 

I(»> -1(0) ♦ rj / *!(*) i*(t)<» ♦T 2 *(t)i'(t) 

0 

1(0 - 1 ( 0 ) *\ I **(») rout *xl((oi , (t) 

0 

vk*r« 

-<*) m ^tMf(t) ♦ "? v i T (t) 

ia4 in desired v«l|ktii| 

Ill i!«yi ooatrol ler UiptitUa lavs are utrmly staple. sad Uanfori, tki hybrid ooatrol algorithm oaa 
ki iapleaeated asiag ki|k stapling ratal (* 1 Di), yielding iaproved performance. Urn da r tka adaptive hybrid 
ooatrollers. both oa4-ef factors ara expected to exert tha daairad forces oa tha load vhlla aiaal tamaoaal y moving 
oa desired trajectories. Tha hybrid-hybrid aoatrol strategy is aoat aaitabla vhaa aiaaltaaaoaa aoatrol of both 
posit loa aad foraa ia reqmired. 


5. MlHlliiLHl CtMllliMI 

TVraa adapt Its aoatrol atratogiaa for cooperative daal-ara robots ara daaaribad ia this papar. Ia thaaa 
strategies. aaah robot ara ia ooaaidarad a sabsystea of tha total syataa aad ia aoatrollad ladioondsatlv aaiag 
aa adaptive ooatrol lar ia tha low level of tha ooatrol hierarchy. Bach ooatrol lor aaaaraa that tha controlled 
v ariablas follow daairad ooaaaads aad raj sot aavaatad cross-conpliag affacta froa othar sebay stems vhioh ara 
traatad aa "distarbaaees.” Tha aabayataaa ara ooordiaatod throagh trajaotory gaaaratora ia tha iataraadiata 
level. vhara ayaohroaoaa desired trajaotorioa for both araa ara apooifiad ia a Qftp qp p task-related fraaa 6f 
reference. Aa iaportaat faatara of tha praaoat approach ia that tha overall ooatrol syataa for N cooperative 
araa ia radaoad to N daeoatral isad iadapaadaat single-ara ooatrollara. Tha ooatrol sohaaaa do aot raqairo 
eoaaaaiea t loa aad data ozehaags aaoag individual ooatrollara. vhioh is aa appeal iag faatara froa both 
oowpmtatioaal aad ral lability poiata of view. Fmrtheraore, availabla taohaiqaaa for aiagle-ara ooatrol oaa bo 
atilisod dirootly ia aaltiplc-sra environments. 

Tha ooatrol atratagios dasoribad ia this papar do aot rsqairs tha kaovlsdgs of tha load paraaatora aaeh as 
■ass a*d stiff mass or tha robot dynamic parameters amok as limk masses aad laartlas. aad oaa tharofora oopo or 1th 
aaoartaiat loa or variations ia tha syataa paraaatora. Fartheraore. tha soaplos dyaaaio aodal of tha araa la aot 
aaad ia gaaaratiag tha ooatrol aotloaa. Tha ooatrol sohaaaa ara vary siapls aad aztraaaly fast for on-liae 
iaplsasata tioa vith high aaapl iag rates, yialdiag iaproved dyaaaio parforaaaoa, Tha ooatrol aathodology 
dasoribad ia this papar oaa also be atilisod ia tha ooordiaatod ooatrol of N-ara robots vhaa N exceeds two. 

d. AfhlPTlfditll 

Tha research dasoribad ia this papar was performed at tha let Propel tioa Laboratory. California laatitato 
of Taohaolog y. eadar eoatraot vith tha National Aoroaantios aad Space Ada ini sirs tioa. 
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Figure 2. Position-Position Control Strategy 



Figure 3. Adaptive Position Control System 


168 


o>Or- 




























Figure 7. Hybrid-Hybrid Control Strategy 
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